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BACKGROUND OF THE INVENTION 

1 . Field of the Invention. 

The present invention is in the field of navigation of vehicles. More 
5 specifically, the present invention relates to a method and apparatus 

for steering vehicles by using a steering control algorithm that takes into account 
the difference between the nominal and optimum positions of a navigation 
antenna. 

10 2. Discussion of the Prior Art. 

The prior art GPS systems are used to manually or automatically steer a 
vehicle (like a tractor) along a predetermined path. To achieve an automatic 
steering, the GPS information is fed to a steering control algorithm which 
calculates an appropriate steering action to steer the tractor (or another vehicle) 

15 onto the prescribed trajectory and keep it on that trajectory. 

However, the prior art automatic steering control algorithm is based, 
among other things, on the assumption that a GPS (or other navigation) antenna 
is mounted at a specific nominal location on the vehicle (like a tractor) at a 
20 predetermined reference point relative to its geometry, for example, on the top of 
the driver's cabin, or over the center of the rear axle. 

The performance of the prior art automatic steering control algorithm is 
dependent on the accuracy of this nominal navigation antenna position. Moving 
25 the navigation antenna to a different location on the vehicle would result in the 
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performance degradation of the automatic steering control algorithm, in the 
undesired weaving, or even in instability. 

On the other hand, the variety of factors may prevent mounting the 
5 navigation antenna at the prescribed nominal location of the vehicle. For 
example, the prescribed nominal location in terms of the steering control 
algorithm for the GPS antenna (for example, the top of the driver's cabin, or the 
center of the rear axle) may be occupied by some other fixtures, such as a CB 
antenna, a projector, etc. 

10 

Thus, in many prior art cases, the actual navigation antenna location on the 
vehicle may be different from the nominal assumed navigation antenna location 
on the vehicle, which can significantly degrade the performance of the prior art 
automatic steering control algorithm. 



20 



25 
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SUMMARY OF THE INVENTION 

To address the shortcomings of the available art, the present invention 
provides a method and apparatus for automatic steering of a vehicle that takes 
into account an actual mounting location of a navigation antenna by modifying the 
input variables into the same prior art automatic steering algorithm. 

One aspect of the present invention is directed to a method of steering a 
vehicle along a predetermined 2-D path on a 2-D plane by using a steering 
control algorithm, wherein the vehicle includes a navigation system and a 
navigation antenna. 

In one embodiment of the present invention, the method of steering a 
vehicle along a predetermined 2-D path on a 2-D plane by using a steering 
control algorithm comprises the following steps: (A) obtaining a set of 
positioning data of the vehicle by using the navigation system and by using the 
navigation antenna mounted at the optimum antenna position; (B) modifying the 
set of positioning data of the vehicle; (C) measuring a steering angle of the front 
wheels of the vehicle relative to a predetermined reference direction on the 2-D 
plane; (D) calculating a correction to the measured steering angle on the 2-D 
plane; and (E) performing a steering action by using the correction to the 
measured steering angle on the 2-D plane in order to move the vehicle along the 
predetermined 2-D path on the 2-D plane. 

In one embodiment of the present invention, the step (A) of obtaining the 
set of positioning data of the vehicle by using the navigation system and by using 
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the navigation antenna mounted at the optimum antenna position further includes 
the step (Al) of obtaining the set of positioning data of the vehicle by using a 
navigation system selected from the group consisting of: {GPS; GLONASS; 
combined GPS/GLONASS; GALILEO; pseudolite-based navigation system; and 
5 inertial navigation system (INS)}. 

In one embodiment of the present invention, the step (B) of modifying the 
set of positioning data of the vehicle further includes the step (Bl) of specifying a 
distance a distance between a nominal antenna position and the optimum antenna 
10 position; wherein the steering control algorithm assumes the nominal antenna 
position at a predetermined reference point. 

In one embodiment of the present invention, the step (C) of measuring the 
steering angle of the vehicle on the 2-D plane further includes the step (CI) of 

15 using an angular sensor to measure the steering angle of the front wheels of the 
vehicle relative to the predetermined reference direction on the 2-D plane. In 
another embodiment of the present invention, the step (C) of measuring the 
steering angle of the vehicle on the 2-D plane further includes the step (C2) of 
using a rotary potentiometer to measure the steering angle of the front wheels of 

20 the vehicle relative to the predetermined reference direction on the 2-D plane. 

In one embodiment of the present invention, the step (D) of calculating the 
correction to the measured steering angle on the 2-D plane further includes the 
steps: (Dl) of feeding a set of control data into the steering control algorithm ; 
25 wherein the set of control data is selected from the group consisting of: {the set 
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of modified positioning data of the vehicle; the measured steering angle on the 2- 
D plane; and a set of data defining the predetermined 2-D path on the 2-D plane}; 
and (D2) of calculating the correction to the measured steering angle on the 2-D 
plane by using the steering control algorithm. 

5 

In one embodiment of the present invention, the step (E) of performing the 
steering action by using the correction to the measured steering angle on the 2-D 
plane further includes the step (El) of using a 2-D hydraulic system to realize the 
correction to the measured steering angle on the 2-D plane. In another 
10 embodiment of the present invention, the step (E) of performing the steering 
action by using the correction to the measured steering angle on the 2-D plane 
further includes the step (E2) of using a 2-D "flight by wire" system to realize 
the correction to the measured steering angle on the 2-D plane. 

15 Another aspect of the present invention is directed to a method of steering 

a vehicle along a predetermined 3-D path on a 3-D surface by using a steering 
control algorithm. 

In one embodiment of the present invention, the method of steering a 
20 vehicle along a predetermined 3-D path on a 3-D surface by using a steering 
control algorithm comprises the following steps: (A) obtaining a set of 3-D 
positioning data of the vehicle by using the navigation system and by using the 
navigation antenna mounted at the optimum antenna position; (B) modifying the 
set of 3-D positioning data of the vehicle; (C) measuring a set of steering angles 
25 on the 3-D surface; (D) calculating a set of corrections to the set of measured 
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steering angles on the 3-D surface; and (E) performing a steering action by using 
the set of corrections to the set of measured steering angles on the 3-D surface in 
order to move the vehicle along the predetermined 3-D path on the 3-D surface. 

In one embodiment of the present invention, the step (A) of obtaining the 
set of 3-D positioning data of the vehicle by using the navigation system and by 
using the navigation antenna mounted at the optimum antenna position further 
includes the step (Al) of obtaining the set of 3-D positioning data of the vehicle 
by using a navigation system selected from the group consisting of: {GPS; 
GLONASS; combined GPS/GLONASS; GALILEO; pseudolite-based navigation 
system; and inertial navigation system (INS)}. 

In one embodiment of the present invention, the step (B) of modifying the 
set of 3-D positioning data of the vehicle further includes the step (Bl) of 
specifying a distance between the nominal antenna position and the optimum 
antenna position. 

In one embodiment of the present invention, the step (C) of measuring the 
set of steering angles of the vehicle on the 3-D surface further includes the step 
(CI) of using at least one angular sensor to measure the set of steering angles on 
the 3-D surface. In another embodiment of the present invention, the step (C) of 
measuring the set of steering angles of the vehicle on the 3-D surface further 
includes the step (C2) of using at least one rotary potentiometer to measure the 
set of steering angles on the 3-D surface. 
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In one embodiment of the present invention, the step (D) of calculating the 
set of corrections to the set of measured steering angles on the 3-D surface 
further includes the steps: (Dl) of feeding a set of control data into the steering 
control algorithm ; wherein the set of control data is selected from the group 
5 consisting of: {the set of modified positioning data of the vehicle; the measured 
steering angle on the 3-D surface; and a set of data defining the predetermined 3- 
D path on the 3-D surface} ; and (D2) of calculating the set of corrections to the 
set of measured steering angles on the 3-D plane by using the steering control 
algorithm. 

10 

In one embodiment of the present invention, the step (E) of performing the 
steering action by using the set of corrections to the set of measured steering 
angles on the 3-D surface further includes the step (El) of using a 3-D hydraulic 
system to realize the set of corrections to the set of measured steering angles on 
15 the 3-D surface. In another embodiment of the present invention, the step (E) of 
performing the steering action by using the set of corrections to the set of 
measured steering angles on the 3-D surface further includes the step (E2) of 
using a 3-D "flight by wire" system to realize the set of corrections to the set of 
measured steering angles on the 3-D plane. 

20 

One more aspect of the present invention is directed to a method of 
steering a vehicle along a 2-D path on a 2-D plane by using a steering control 
algorithm. 



25 



In one embodiment of the present invention, the method of steering a 
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vehicle along a 2-D path on a 2-D plane by using a steering control algorithm 
comprises the following steps: (A) obtaining a set of positioning data of the 
vehicle by using the navigation system and by using the navigation antenna 
mounted at the optimum antenna position; (B) obtaining a set of positioning data 
5 that defines the 2-D path on the 2-D plane; (C) modifying the set of positioning 
data of the vehicle; (D) measuring a steering angle of the front wheels of the 
vehicle relative to a predetermined reference direction on the 2-D plane; (E) 
calculating a correction to the measured steering angle on the 2-D plane; and (F) 
performing a steering action by using the correction to the measured steering 
10 angle on the 2-D plane in order to move the vehicle along the 2-D path on the 2- 
D plane. 

In one embodiment Of the present invention, the step (B) of obtaining the 
set of positioning data that defines the 2-D path on the 2-D plane further includes 
15 the step (Bl) of receiving the set of positioning data that defines the 2-D path on 
the 2-D plane by the navigation antenna. 

In one embodiment of the present invention, the step (Bl) of receiving the 
set of positioning data that defines the 2-D path on the 2-D plane further includes 

20 the step (Bl ,1) of receiving a set of broadcasted positioning data that defines the 
2-D path on the 2-D plane. In this embodiment of the present invention, the set of 
broadcasted positioning data that defines the 2-D path on the 2-D plane is 
broadcasted by a Base Station (BS). In another embodiment of the present 
invention, the step (Bl) of receiving the set of positioning data that defines the 

25 2-D path on the 2-D plane further includes the step (Bl,2) of receiving a set of 

A-1451/Tank-228 9 January 22, 2004 



Web-casted positioning data that defines the 2-D path on the 2-D plane. In this 
embodiment of the present invention, the set of Web-casted positioning data that 
defines the 2-D path on the 2-D plane is Web-casted from an Internet web-site. 

One additional aspect of the present invention is directed to a method of 
steering a vehicle along a 3-D path on a 3-D surface by using a steering control 
algorithm. 

In one embodiment of the present invention, the method of steering a 
vehicle along a 3-D path on a 3-D surface by using a steering control algorithm 
comprises the following steps: (A) obtaining a set of positioning data of the 
vehicle by using the navigation system and by using the navigation antenna 
mounted at the optimum antenna position; (B) obtaining a set of positioning data 
that defines the 3-D path on the 3-D surface; (C) modifying the set of positioning 
data of the vehicle; (D) measuring a set of steering angles of the front wheels of 
the vehicle on the 3-D surface; (E) calculating a set of corrections to the set of 
measured steering angles on the 3-D surface; and (F) performing a steering 
action by using the set of corrections to the set of measured steering angles on the 
3-D surface in order to move the vehicle along the 3-D path on the 3-D surface. 

In one embodiment of the present invention, the step (B) of obtaining the 
set of positioning data that defines the 3-D path on the 3-D surface further 
includes the step (Bl) of receiving the set of positioning data that defines the 3-D 
path on the 3-D surface by the navigation antenna. 
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In one embodiment of the present invention, the step (Bl) of receiving the 
set of positioning data that defines the 3-D path on the 3-D surface further 
includes the step (Bl,l) of receiving a set of broadcasted positioning data that 
defines the 3-D path on the 3-D surface. In this embodiment, the set of 
broadcasted positioning data that defines the 3-D path on the 3-D surface is 
broadcasted by a Base Station (BS). In another embodiment of the present 
invention, the step (Bl) of receiving the set of positioning data that defines the 3- 
D path on the 3-D surface further includes the step (Bl,2) of receiving the set of 
Web-casted positioning data that defines the 3-D path on the 3-D surface. In this 
embodiment, the set of Web-Casted positioning data that defines the 3-D path on 
the 3-D surface is Web-casted from an Internet web-site. 

Yet, one more aspect of the present invention is directed to an apparatus 
for steering a vehicle along a predetermined 2-D path on a 2-D plane. 
In one embodiment of the present invention, the apparatus for steering a vehicle 
along a predetermined 2-D path on a 2-D plane comprises: (A) a means for 
obtaining a set of positioning data of the vehicle; (B) a means for modifying the 
set of positioning data of the vehicle; (C) a means for measuring a steering angle 
of the front wheels of the vehicle relative to a predetermined reference direction 
on the 2-D plane; (D) a means for calculating a correction to the measured 
steering angle on the 2-D plane; and (E) a means for performing a steering action 
by using the correction to the measured steering angle on the 2-D plane in order 
to move the vehicle along the predetermined 2-D path on the 2-D plane. In one 
embodiment of the present invention, the (A) means for obtaining the set of 
positioning data of the vehicle further includes: (Al) a navigation system selected 
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from the group consisting of: {GPS; GLONASS; combined GPS/GLONASS; 
GALILEO; pseudolite-based navigation system; and inertial navigation system 
(INS)}; and (A2) a navigation antenna mounted on the vehicle at an optimum 
antenna position. In one embodiment of the present invention, the means (C) for 
measuring the steering angle of the front wheels of the vehicle relative to the 
predetermined reference direction on the 2-D plane further includes an angular 
sensor (or a rotary potentiometer) configured to measure the steering angle of the 
front wheels of the vehicle relative to the predetermined reference direction on 
the 2-D plane. In one embodiment of the present invention, the means (D) for 
calculating the correction to the measured steering angle on the 2-D plane further 
includes (Dl) a steering control algorithm configured to use a set of control data 
to calculate the correction to the measured steering angle on the 2-D plane, 
wherein the set of control data is selected from the group consisting of: {the set 
of modified positioning data of the vehicle; the measured steering angle on the 2- 
D plane; and a set of data defining the predetermined 2-D path on the 2-D 
plane}. In one embodiment of the present invention, the means (E) for performing 
the steering action by using the correction to the measured steering angle on the 
2-D plane further includes: (El) a 2-D hydraulic system configured to realize the 
correction to the measured steering angle on the 2-D plane; or (E2) a 2-D "flight 
by wire" system configured to realize the correction to the measured steering 
angle on the 2-D plane. 

Yet, one additional aspect of the present invention is directed to an 
apparatus for steering a vehicle along a predetermined 3-D path on a 3-D surface. 
In one embodiment of the present invention, the apparatus for steering a vehicle 
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along a predetermined 3-D path on a 3-D surface comprises: (A) a means for 
obtaining a set of positioning data of the vehicle; (B) a means for modifying the 
set of positioning data of the vehicle; (C) a 3-D means for measuring a set of 
steering angles of the front wheels of the vehicle relative to a predetermined 
reference direction on the 3-D surface; (D) a means for calculating a set of 
corrections to the set of measured steering angles on the 3-D surface; and (E) a 
means for performing a steering action by using the set of corrections to the set 
of measured steering angles on the 3-D surface in order to move the vehicle 
along the predetermined 3-D path on the 3-D surface. In one embodiment of the 
present invention, the (A) means for obtaining the set of positioning data of the 
vehicle further includes: (Al) a navigation system selected from the group 
consisting of: {GPS; GLONASS; combined GPS/GLONASS; GALILEO; 
pseudolite-based navigation system; and inertial navigation system (INS)}; and 
(A2) a navigation antenna mounted on the vehicle at an optimum antenna 
position. In one embodiment of the present invention, the means (B) for 
modifying the set of positioning data of the vehicle further includes a means for 
specifying a distance between the nominal navigation antenna position and the 
optimum navigation antenna position. In one embodiment of the present 
invention, the 3-D means (C) for measuring the set of steering angles of the front 
wheels of the vehicle relative to the predetermined reference direction on the 3-D 
surface further includes an angular sensor (or a rotary potentiometer) configured 
to measure the set of steering angles of the front wheels of the vehicle relative to 
the predetermined reference direction on the 3-D surface. In one embodiment of 
the present invention, the means (D) for calculating the set of corrections to the 
set of measured steering angles on the 3-D surface further includes (Dl) a 
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steering control algorithm configured to use a set of control data to calculate the 
set of corrections to the set of measured steering angles on the 3-D surface; 
wherein the set of control data is selected from the group consisting of: {the set 
of modified positioning data of the vehicle; the measured steering angle on the 3- 

5 D surface; and a set of data defining the predetermined 2-D path on the 3-D 
surface} . In one embodiment of the present invention, the means (E) for 
performing the steering action by using the set of corrections to the set of 
measured steering angles on the 3-D surface further includes: (El) a 3-D 
hydraulic system configured to realize the set of corrections to the set of 

10 measured steering angles on the 3-D surface; or (E2) a 3-D "flight by wire" 

system configured to realize the set of corrections to the set of measured steering 
angles on the 3-D surface. 



25 
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BRIEF DESCRIPTION OF DRAWINGS 

The aforementioned advantages of the present invention as well as 
additional advantages thereof will be more clearly understood hereinafter as a 
result of a detailed description of a preferred embodiment of the invention when 
5 taken in conjunction with the following drawings. 

FIG. 1 depicts an information flow chart for the method of the present invention 
of steering a vehicle along a predetermined path by using a steering control 
algorithm. 

10 

FIG. 2 is an example of an actual tractor geometry and different geometrical 
relationship for the purposes of the control algorithm of the present invention. 

FIG. 3 illustrates how to transform the input data for a control algorithm 
15 designed for a vehicle having a navigation antenna mounted at the optimum for 
such a vehicle location which is different from the predetermined nominal 
antenna location. 



25 
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DETAILED DESCRIPTION OF THE PREFERRED AND ALTERNATIVE 
EMBODIMENTS. 



Reference will now be made in detail to the preferred embodiments of the 
invention, examples of which are illustrated in the accompanying drawings. 
While the invention will be described in conjunction with the preferred 
embodiments, it will be understood that they are not intended to limit the 
invention to these embodiments. On the contrary, the invention is intended to 
cover alternatives, modifications and equivalents that may be included within the 
spirit and scope of the invention as defined by the appended claims. Furthermore, 
in the following detailed description of the present invention, numerous specific 
details are set forth in order to provide a thorough understanding of the present 
invention. However, it will be obvious to one of ordinary skill in the art that the 
present invention may be practiced without these specific details. In other 
instances, well known methods, procedures, components, and circuits have not 
been described in detail as not to unnecessarily obscure aspects of the present 
invention. 

FIG. 1 depicts an information flow chart 10 for the method of the present 
invention for steering a vehicle 28 along a predetermined path by using a steering 
control algorithm 16. The vehicle 28 of FIG. 1 includes a navigation system 13. 
In one embodiment of the present invention, the vehicle 28 of FIG. 1 includes a 
GPS navigation system 13 including a GPS receiver 14 and GPS antenna 14. In 
alternative embodiments of the present invention (not shown), the navigation 
system 13 is selected from the group consisting of: {GLONASS; combined 
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GPS/GLONASS; GALILEO; pseudolite-based navigation system; and inertial 
navigation system (INS)}. 

The Global Positioning System (GPS) is a system of satellite signal 
5 transmitters that transmits information from which an observer's present location 
and/or the time of observation can be determined. Another satellite-based 
navigation system is called the Global Orbiting Navigational System 
(GLONASS), which can operate as an alternative or supplemental system. 

10 The GPS was developed by the United States Department of Defense 

(DOD) under its NAVSTAR satellite program. A fully operational GPS includes 
more than 24 Earth orbiting satellites approximately uniformly dispersed around 
six circular orbits with four satellites each, the orbits being inclined at an angle of 
55° relative to the equator and being separated from each other by multiples of 

15 60° longitude. The orbits have radii of 26,560 kilometers and are approximately 
circular. The orbits are non-geosynchronous, with 0.5 sidereal day (11.967 
hours) orbital time intervals, so that the satellites move with time relative to the 
Earth below. Generally, four or more GPS satellites will be visible from most 
points on the Earth's surface, which can be used to determine an observer's 

20 position anywhere on the Earth's surface. Each satellite carries a cesium or 

rubidium atomic clock to provide timing information for the signals transmitted 
by the satellites. An internal clock correction is provided for each satellite clock. 

Each GPS satellite continuously transmits two spread spectrum, L-band 
25 carrier signals: an LI signal having a frequency fl = 1575.42 MHz 
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(approximately nineteen centimeter carrier wavelength) and an L2 signal having a 
frequency f2 = 1227.6 MHz (approximately twenty-four centimeter carrier 
wavelength). These two frequencies are integral multiplies f 1 = 1 ,540 f0 and f2 
= 1,200 fO of a base frequency AO = 1.023 MHz. The LI signal from each 

5 satellite is binary phase shift key (BPSK) modulated by two pseudo-random noise 
(PRN) codes in phase quadrature, designated as the C/A-code and P-code. The 
L2 signal from each satellite is BPSK modulated by only the P-code. The nature 
of these PRN codes and accepted methods for generating the C/A-code and P- 
code are set forth in the document ICD-GPS-200: GPS Interface Control 

10 Document, ARINC Research, 1997, GPS Joint Program Office, which is 
incorporated by reference herein. 

The GPS satellite bit stream includes navigational information on the 
ephemeris of the transmitting GPS satellite (which includes orbital information 

15 about the transmitting satellite within next several hours of transmission) and an 
almanac for all GPS satellites (which includes a less detailed orbital information 
about all satellites). The transmitted satellite information also includes parameters 
providing corrections for ionospheric signal propagation delays (suitable for 
single frequency receivers) and for an offset time between satellite clock time and 

20 true GPS time. The navigational information is transmitted at a rate of 50 Baud. 

A second satellite-based navigation system is the Global Orbiting 
Navigation Satellite System (GLONASS), placed in orbit by the former Soviet 
Union and now maintained by the Russian Republic. GLONASS uses 24 
25 satellites, distributed approximately uniformly in three orbital planes of eight 
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satellites each. Each orbital plane has a nominal inclination of 64.8° relative to 
the equator, and the three orbital planes are separated from each other by 
multiples of 120° longitude. The GLONASS satellites have circular orbits with a 
radii of about 25,510 kilometers and a satellite period of revolution of 8/17 of a 
sidereal day (11.26 hours). A GLONASS satellite and a GPS satellite will thus 
complete 17 and 16 revolutions, respectively, around the Earth every 8 days. The 
GLONASS system uses two carrier signals LI and L2 with frequencies of fl = 
(1.602 + 9k/16) GHz and f2 = (1.246 + 7k/16) GHz, where k =(1,2,. ..24) is 
the channel or satellite number. These frequencies lie in two bands at 1.597- 
1.617 GHz (LI) and 1,240-1,260 GHz (L2). The LI signal is modulated by a 
C/A- code (chip rate = 0.511 MHz) and by a P-code (chip rate = 5.11 MHz). 
The L2 signal is presently modulated only by the P-code. The GLONASS 
satellites also transmit navigational data at a rate of 50 Baud. Because the channel 
frequencies are distinguishable from each other, the P-code is the same, and the 
C/A-code is the same, for each satellite. The methods for receiving and 
demodulating the GLONASS signals are similar to the methods used for the GPS 
signals. Reference to a Satellite Positioning System or SATPS herein refers to a 
Global Positioning System, to a Global Orbiting Navigation System, and to any 
other compatible satellite-based system that provides information by which an 
observer's position and the time of observation can be determined, all of which 
meet the requirements of the present invention. 

GALILEO will be Europe's own global navigation satellite system, 
providing a highly accurate, guaranteed global positioning service under civilian 
control. It will be inter-operable with GPS and GLONASS, the two other global 
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satellite navigation systems. A user will be able to take a position with the same 
receiver from any of the satellites in any combination. By offering dual 
frequencies as standard, however, GALILEO will deliver real-time positioning 
accuracy down to the meter range, which is unprecedented for a publicly 
5 available system. It will guarantee availability of the service under all but the 
most extreme circumstances and will inform users within seconds of a failure of 
any satellite. This will make it suitable for applications where safety is crucial, 
such as running trains, guiding cars and landing aircraft. 

10 The first experimental satellite, part of the so-called GALILEO System 

Test Bed (GSTB) will be launched in the second semester of 2005. The objective 
of this experimental satellite is to characterize the critical technologies, which are 
already under development under ESA contracts. Thereafter up to four 
operational satellites will be launched in the time frame 2005-2006 to validate the 

15 basic GALILEO space and related ground segment. Once this In-Orbit Validation 
(IO V) phase has been completed, the remaining satellites will be installed to 
reach the Full Operational Capability (FOC) in 2008. 

The fully deployed GALILEO system consists of 30 satellites (27 
20 operational + 3 active spares), positioned in three circular Medium Earth Orbit 
(MEO) planes in 23616 km altitude above the Earth, and at an inclination of the 
orbital planes of 56 degrees with reference to the equatorial plane. Once this is 
achieved, the GALILEO navigation signals will provide a good coverage even at 
latitudes up to 75 degrees north, which corresponds to the North Cape, and 
25 beyond. The large number of satellites together with the optimization of the 
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constellation, and the availability of the three active spare satellites, will ensure 
that the loss of one satellite has no discernible effect on the user. 

Two GALILEO Control Centers (GCC) will be implemented on European 
5 ground to provide for the control of the satellites and to perform the navigation 
mission management. The data provided by a global network of twenty 
GALILEO Sensor Stations (GSS) will be sent to the GALILEO Control Centers 
through a redundant communications network. The GCC's will use the data of 
the Sensor Stations to compute the integrity information and to synchronize the 

10 time signal of all satellites and of the ground station clocks. The exchange of the 
data between the Control Centers and the satellites will be performed through so- 
called up-link stations. Five S-band up-link stations and 10 C-band up-link 
stations will be installed around the globe for this purpose. As a further feature, 
GALILEO will provide a global Search and Rescue (SAR) function, based on the 

15 operational Cospas-Sarsat system. To do so, each satellite will be equipped with 
a transponder, which is able to transfer the distress signals from the user 
transmitters to the Rescue Co-ordination Center, which will then initiate the 
rescue operation. At the same time, the system will provide a signal to the user, 
informing him that his situation has been detected and that help is under way. 

20 This latter feature is new and is considered a major upgrade compared to the 
existing system, which does not provide a feedback to the user. 

A Satellite Positioning System (SATPS), such as the Global Positioning 
System (GPS), or the Global Orbiting Navigation Satellite System (GLONASS), 
25 or the combined GPS-GLONASS, (or the future GALILEO), uses transmission 
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of coded radio signals, with the structure described above, from a plurality of 
Earth-orbiting satellites. An SATPS antenna receives SATPS signals from a 
plurality (preferably four or more) of SATPS satellites and passes these signals to 
an SATPS signal receiver/processor, which (1) identifies the SATPS satellite 
source for each SATPS signal, (2) determines the time at which each identified 
SATPS signal arrives at the antenna, and (3) determines the present location of 
the SATPS satellites. The range (r;) between the location of the i-th SATPS 
satellite and the SATPS receiver is equal to the speed of light c times (Atj), 
wherein (At 4 ) is the time difference between the SATPS receiver's clock and the 
time indicated by the satellite when it transmitted the relevant phase. However, 
the SATPS receiver has an inexpensive quartz clock which is not synchronized 
with respect to the much more stable and precise atomic clocks carried on board 
the satellites. Consequently, the SATPS receiver estimates a pseudo-range (pr^ 
(not a true range) to each satellite. After the SATPS receiver determines the 
coordinates of the i-th SATPS satellite by demodulating the transmitted ephemeris 
parameters, the SATPS receiver can obtain the solution of the set of the 
simultaneous equations for its unknown coordinates (Xq, y 0 , z 0 ) and for unknown 
time bias error (cb). The SATPS receiver can also determine velocity of a 
moving platform. 

Referring still to FIG. 1, in one embodiment of the present invention, the 
navigation system 13 comprises a pseudolite navigation system. Pseudolites are 
ground-based transmitters that can be configured to emit GPS-like signals for 
enhancing the GPS by providing increased accuracy, integrity, and availability. 
Accuracy improvement can occur because of better local geometry, as measured 
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by a lower vertical dilution of precision (VDOP). Availability is increased 
because a pseudolite provides an additional ranging source to augment the GPS 
constellation. 

5 Referring still to FIG. 1 , in one embodiment of the present invention, the 

navigation system 13 comprises an Inertial Navigation System (INS). Recent 
advances in Inertial Navigation Systems (INS) technologies makes it feasible to 
build a very small, low power INS system. Acceleron Technology, Inc., located 
in San Francisco, California, has built small light weight Inertial Navigation 

10 System (INS) using three accelerometers to measure three components of the 
local acceleration vector, three magnetometers to measure three components of 
the local gravitational vector, plus some software. An accelerometer is a sensor 
that measures acceleration, speed and the distance by mathematically determining 
acceleration over time. A magnetometer is a device that measures a local 

15 magnetic field. The local gravitational factor can be calculated by using the 

measured local magnetic field, because the local gravitational field, as well as the 
local magnetic field, are both defined by the local Earth geometry, as well 
explained in the book "Applied Mathematics in Integrated Navigation Systems", 
published by American Institute of Aeronautics and Astronautics, Inc, 2000, by 

20 Robert M. Rogers. The "Applied Mathematics in Integrated Navigation Systems" 
teaches how geometrical shape and gravitational models for representing the 
Earth are used to provide relationship between ECEF position x-y-z components 
and local-level latitude, longitude, and attitude positions. The "Applied 
Mathematics in Integrated Navigation Systems"also teaches how a vehicle's 

25 position change in geographical coordinates is related to the local Earth relative 
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velocity and Earth curvature. 



In one embodiment of the present invention, FIG. 1 depicts an information 
flow chart 10 for the method of the present invention of steering a vehicle 28 
along a predetermined 2-D path on a 2-D plane by using a steering control 
algorithm 16. In this embodiment of the present invention, the geometrical 
trajectory of the desired route (for instance, a trajectory Y=y (x; z = const) that 
defines a predetermined 2-D path) is input into the memory (not shown) of the 
navigation system 13 beforehand. 

In another embodiment of the present invention, FIG. 1 depicts an 
information flow chart 10 for the method of the present invention of steering a 
vehicle 28 along a 2-D path on a 2-D plane by using a steering control algorithm 
16, wherein the geometrical trajectory of the desired route (for instance, the same 
trajectory Y=y (x; z = const)) does not define a predetermined 2-D path. 
Instead, the trajectory Y=y (x; z = const) is input into the memory (not shown) 
of the navigation system 13 in real time to take into account the obstacles, like 
boulders, animals, people, trees, or other obstructions that may enter the path of 
a vehicle unexpectedly. In one embodiment, the real-time 2-D trajectory can be 
broadcasted from a Base Station. In another embodiment, the real-time 2-D 
trajectory can be broadcasted from a continuously updated real time Web Site. 

In one embodiment, the navigation system 13 (of FIG.l ) provides for 
different modes of control. These modes include (1) a fully autonomous mode, 
where navigation of the vehicle 28 is automatically handled by the on-board 
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navigation system 13; (2) a tele or remote control mode, where a remote human 
operator may control the direction and motion, and so on, of the vehicle 28; and 
(3) a manual mode, where a human operator sitting in the cab can take control of 
the vehicle and drive it manually. 

5 

In one embodiment, the navigation system, referring still to FIG. 1, the 
navigation system 13 (fully described above) is used to obtain a set of positioning 
data of the vehicle 28 on the predetermined 2-D trajectory on a 2-D plane (z = 
const) Y=Y(x: z =const)), or on the real-time inputted 2-D trajectory on a 2-D 

10 plane (z = const) Y=Y(x: z = const)) by using the navigation antenna 12 
mounted at the optimum antenna position. However, the steering control 
algorithm 16 assumes the different, nominal antenna position at the 
predetermined reference point. Therefore, the positioning data of the vehicle 28 
(the vehicle's coordinates and the vehicle's velocity vector) obtained by the 

15 navigation antenna 12 should be modified to take into account the difference 

between the nominal antenna position and the optimum antenna position. (Please, 
see discussion below). 

In one embodiment of the present invention, referring still to the 
20 information flow for the automatic steering control algorithm depicted in FIG. 1, 
block 16 includes a typical automatic steering control algorithm itself which uses 
as a reference point the predetermined reference point of the vehicle 28. (Please, 
see discussion below). 

25 In one embodiment of the present invention, when the vehicle 28 
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(of FIG. 1) includes a tractor, the predetermined reference point of the vehicle 
for the purposes of the typical automatic steering control algorithm lies in the 
center of the rear axle of a front steer tractor. The algorithm utilizes the 
coordinates and the velocity vector (the speed and the direction -heading) of the 

5 navigation antenna 12 (for instance, a GPS antenna 12). This set of data 15 (the 
coordinates and the velocity vector) is typically provided by the navigation 
receiver 14 (for example, by a GPS receiver 14). In this embodiment, the angle 
of the front wheels of the vehicle relative to the rear axle is also measured, for 
example by a rotary potentiometer or other suitable sensor. The set of measured 

10 steering angles data 22 is provided to the control algorithm 16. In this 

embodiment, the set of geometric data 24 related to the tractor, such as the 
distance between the rear axle and the front axle, is also provided to the control 
algorithm 16. The distance between the rear axle and the front axle should be 
specified. This can be done either by measuring directly the distance between the 

15 rear axle and the front axle of the vehicle, or by calculating the distance between 
the rear axle and the front axle based on known geometry of the vehicle. 

Based on all this information, including the set of position data 15, the 
velocity vector 15, the set of measured steering angles, and the set of tractor 
20 geometrical data 24 including the distance between the rear axle and the front 

axle , the automatic steering control algorithm 16 calculates a correction 17 to the 
steering angle, which, by a suitable mechanism, such as a hydraulic system 18, is 
transformed to the set of angular steering adjustments 20 for the tractor. 

25 As was stated above, the predetermined reference point of the vehicle for 
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the purposes of the typical automatic steering control algorithm lies in the center 
of the rear axle of a front steer tractor. If the navigation antenna 12 (for instance, 
the GPS antenna) is actually mounted over the center of the rear axle, the 
automatic control steering algorithm 16 (of FIG. 1) will perform as designed. 
5 However, if the navigation antenna 12 (for instance, the GPS antenna) is 

placed at the optimum position which is different form the nominal predetermined 
antenna position, the control algorithm will interpret the received position and 
velocity of the vehicle as if the position and velocity of the vehicle are determined 
at the center of the rear axle. Consequently, the control algorithm would 
10 calculate the erroneous adjustments to the steering angle, thus resulting in a poor 
automatic steering performance of the control algorithm. 

The present invention is designed to make adjustments to the position and 
velocity of the vehicle 28 determined by the navigation system 13 to 

15 accommodate for the actual optimum position of the navigation antenna, so that 
the adjusted position and velocity correspond to the position and the velocity of 
the vehicle 28 at the nominal predetermined antenna position, i.e., at the center 
of the rear axle in this example. Thus, the control algorithm itself is never 
modified, but rather its input information is pre-adjusted. This provides a very 

20 practical method to adapt the automatic steering algorithm to various tractors and 
tractor configurations. Please, see the full discussion below. 

FIG. 2 depicts as an example an actual tractor geometry 40 and different 
geometrical relationship for the purposes of the control algorithm of the present 
25 invention including: the actual optimum antenna position 42, the reference 

A-1451/Tank-228 27 January 22, 2004 



nominal antenna position 44, the left front wheel 46, the velocity vector V ref at 
the reference point 48, the GPS-derived velocity V GPS 50, the angle S 52 between 
the rear axle center velocity V ref and the GPS antenna velocity V GPS , the right 
front wheel 53, and the center of rotation 54. 

5 

An automatic steering algorithm can be formulated for any position of the 
navigation antenna (for instance, the GPS antenna). However, the prior art 
requires the formulation and design of the algorithm for each and every 
placement of the navigation (GPS) antenna. The present invention allows one to 
10 use a single automatic steering algorithm for any position of the navigation 

antenna without any change, provided that the obtained coordinates and velocity 
of the vehicle are transformed based on the steering angle and the relative 
position of the antenna with respect to the reference point. 

15 More specifically, in one embodiment of the prior art, the basic steering 

algorithm is as follows: 

9=G(P, W 0 xJ; (Eq.l) 
20 where 

G is the steering control algorithm parameterized by P; 

P are the parameters of the vehicle, such as its length, height, width, current 

speed, etc; 

¥ e is the error in the heading, i.e., the difference between a desired direction and 
25 the current direction of the motion of the vehicle; 
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x e is the error in the position, i.e., the difference between a desired position and the 
current position of the vehicle; 

0is a calculated desired steering angle, which, when enforced to the steering 
mechanism of the vehicle, moves the vehicle onto a desired path such that W e and 
x e become zero over time 

When these error terms are zero and stay zero, the vehicle is on-track. 

Some prior art basic steering algorithms are scalable. One explicit example 
of a scalable steering control algorithm G of Eq. (1) is given below. This scalable 
steering control algorithm G assumes a front-steer type, and assumes that the 
GPS antenna is mounted over the center of the rear axle: 

desire* = (L/V)Ky¥ e + (L/V 2 )^. (Eq. 2). 

where 

W e is the heading error with reference to a desired trajectory and with the reference 
to the GPS antenna location on the tractor; 

x e is the position error with reference to a desired trajectory and with the reference 
to the GPS antenna location on the tractor. 

The scalable control algorithm given in Eq. (2) includes the method of 
calculating the desired steering angle @ desired that is parameterized by the length of 
the vehicle (tractor) L and by the speed of the vehicle (tractor) V. Hence, this 
algorithm is applicable to a wide range of vehicles (tractors) with different 
lengths and at different driving speeds provided the navigation (GPS) antenna is 
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mounted over the center of the rear axle. 

The scalability of the control algorithm is significant because, otherwise, 
one would need to develop a steering control algorithm for every type of vehicle. 
5 However, the same scalable control algorithm is applicable to all vehicles of the 
same class. For instance, as all front steer vehicles can use the same steering 
control algorithm by simply using the particular measurable vehicle parameter, 
like its length L. The scalable control algorithm is valid at any constant vehicle's 
speed V. 

10 

The prior art steering control algorithm takes as its input data the positional 
data and the velocity vector of the vehicle obtained by its navigation system 
having a navigation antenna mounted at the nominal predetermined location 44 
(of FIG. 1). However, there are situations when a navigation antenna (for 

15 example, a GPS antenna) cannot be mounted at the nominal predetermined 

location 44 (of FIG. 2), as illustrated in diagram 60 of FIG. 3. If this is the case, 
the position and speed (velocity) information obtained by its navigation system 
having a navigation antenna mounted at the optimum location 62 can be translated 
into the speed (velocity) and position of the vehicle at the referenced (expected) 

20 nominal location 64 of the navigation (GPS) antenna. In the example given 60 in 
FIG. 3, the nominal antenna mounting location 62 is at the center of the rear 
axle. 

EXAMPLE. 

25 Translation of the position and speed (velocity) information obtained by the 
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navigation system having the navigation antenna mounted at the optimum location 
62 into the speed (velocity) and position at the referenced (expected) nominal 
location 64 of the navigation (GPS) antenna, as illustrated in FIG. 3: 



¥ , the heading error at the GPS antenna mounting location 62; 

Vgp S 66, the velocity obtained by the GPS antenna at the GPS antenna mounting 

location 62; 

x e-gps 68, the position error at the location of the GPS antenna with regard to the 

desired trajectory 70; 

012, the measured steering angle; 

L G ps 74 , the measured distance between the reference point 64 and the location 
of the GPS antenna 62; 
The following variables: 

^e-ref 76, the heading error at the reference point 64; 
V ref 78, the velocity at the reference point 64; 
and 

jc e . re/ 80, the position error at the reference point 64 with respect to the desired 
trajectory 70; 

are calculated as follows by the using the control algorithm in the scalable form 
given by (Eq. 2): 



IF: 



w = w -fy 

* e-ref e-gps ' 

V ref = VJcosiQ); 
x e -ref= x e ^ s -L GPS tan(0). 



(Eq. 3) 
(Eq. 4) 
(Eq. 4). 
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In the example above, the vehicle was positioned in a 2-D plane and the 
reference trajectory was shown to be a straight line, for the sake of simplicity in 
explaining the concept. This process can be generalized to spatial 2-D positioning 
and arbitrary shaped 2-D reference trajectories. 

In one embodiment of the present invention, the steering angle 0 of the 
vehicle on the 2-D plane can be measured by using an angular sensor. 
FUTEK Advanced Sensor Technology, located at 10 Thomas, Irvine, CA 92618 
USA, manufactures angular sensors for robotic control that can be used for the 
purposes of the present invention. In another embodiment of the present 
invention, the steering angle & of the vehicle on the 2-D plane can be measured 
by using a rotary potentiometer. Servo Instrument Corporation Manufacturer 
located at 240 Lynn Street, P.O. Box 43, Baraboo, WI 53913, manufactures a 
complete line of precision conductive plastic and wirewound potentiometers that 
can be used for the purposes of the present invention. 

In one embodiment of the present invention, the actual steering action on 
the 2-D plane can be performed by using a 2-D hydraulic system. Hydraulic 
Systems Limited, headquartered in Dartmouth, Nova Scotia, manufactures a wide 
array of hydraulic power systems that can be used to realize the correction to the 
measured steering angle on the 2-D plane. 

In another embodiment of the present invention, the actual steering action 
on the 2-D plane can be performed by using a 2-D "flight by wire" system. 
General Motors is working to perfect an electronic power steering system, or a 
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"flight by wire" system, for its new cars. This electronic power steering system 
can be used for the purposes of the present invention in order to realize the 
correction to the measured steering angle on the 2-D plane. 

5 Another aspect of the present invention is directed to a method of steering 

a vehicle along a predetermined, (or along a real time inputted, or broadcasted) 
3-D path on a 3-D surface by using a steering control algorithm. Indeed, the 
above given discussion can be generalized to a more general situation when a 
vehicle is moving along a predetermined 3-D path on a 3-D surface. 
10 If this is the case, a single steering angle should be replaced by a set of measured 
steering angles {roll, yaw, and pitch} on the 3-D surface; and a steering action 
should be performed by using the set of corrections to the set of measured 
steering angles {roll, yaw, and pitch} on the 3-D surface in order to move the 
vehicle along the predetermined 3-D path on the 3-D surface. 

15 

In order to calculate the set of corrections to the set of measured steering 
angles on the 3-D plane, one should use the generalized steering control 
algorithm in its scalable form: 

20 YAW desired = (L/V)K yaw , y<r e +(L/V)K yaw ,** e + (L/V 2 )K y ^ e +(L/V 2 )K yaw , y y e . (Eq.5) 
Roll desired = (L/V)K ro u, r¥ e + (L/V)K roll>0 ^(L/^)K roll ^(L/^)K roU ^ (Eq.6) 
Pitch desired =(L/V)K pilch , ^(L/VjK^^+fL/V 2 )^^^ 



25 



where: 

¥ e is the heading error in 'x' direction with reference to a desired trajectory and 
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with the reference to the GPS antenna location on the tractor; 
x e is the position error in 'x' direction with reference to a desired trajectory and 
with the reference to the GPS antenna location on the tractor; 
0 e is the heading error in 'y' direction with reference to a desired trajectory and 
5 with the reference to the GPS antenna location on the tractor; 

y e is the position error in 'y' direction with reference to a desired trajectory and 
with the reference to the GPS antenna location on the tractor. 



25 
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The foregoing description of specific embodiments of the present invention 
have been presented for purposes of illustration and description. They are not 
intended to be exhaustive or to limit the invention to the precise forms disclosed, 
and obviously many modifications and variations are possible in light of the 

5 above teaching. The embodiments were chosen and described in order to best 
explain the principles of the invention and its practical application, to thereby 
enable others skilled in the art to best utilize the invention and various 
embodiments with various modifications as are suited to the particular use 
contemplated. It is intended that the scope of the invention be defined by the 

10 claims appended hereto and their equivalents. 
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